#include <hardware/servo/servo.h>

void initServo()
{
    // 设置舵机控制针脚接数字7引脚
    pinMode(SERVO_PIN, OUTPUT);
}

void runServo(int angle)
{
     for (int i = 0; i < 6; i++)
     {
         int pulsewidth = (angle * 11) + 500;
         digitalWrite(SERVO_PIN, HIGH);
         delayMicroseconds(pulsewidth);
         digitalWrite(SERVO_PIN, LOW);
         delayMicroseconds(20000 - pulsewidth);
     }
}
void pushButton()
{
    runServo(servoDefaultAngle + configData.servoAngle);
    delay(servoDefaultStopTime + configData.servoStopTime);
    runServo(0);
}